#ifndef ROBOTMAP_H
#define ROBOTMAP_H

#define DSPrintLine DriverStationLCD::GetInstance()->PrintfLine
#define LINE1 DriverStationLCD::kUser_Line1
#define LINE2 DriverStationLCD::kUser_Line2
#define LINE3 DriverStationLCD::kUser_Line3
#define LINE4 DriverStationLCD::kUser_Line4
#define LINE5 DriverStationLCD::kUser_Line5
#define LINE6 DriverStationLCD::kUser_Line6

/**
 * The RobotMap is a mapping from the ports sensors and actuators are wired into
 * to a variable name. This provides flexibility changing wiring, makes checking
 * the wiring easier and significantly reduces the number of magic numbers
 * floating around.
 */
 
// For example to map the left and right motors, you could define the
// following variables to use with your drivetrain subsystem.
// #define LEFTMOTOR 1
// #define RIGHTMOTOR 2

// If you are using multiple modules, make sure to define both the port
// number and the module. For example you with a rangefinder:
// #define RANGE_FINDER_PORT 1
// #define RANGE_FINDER_MODULE 1
//MODULES
#define ANALOG_MODULE	1
#define DIGITAL_MODULE	1
#define SOLENOID_MODULE	1

//DIO AUTO SWITCHES
#define AUTO_SWITCH_1 8 
#define AUTO_SWITCH_2 9
//VICTORS
#define JAGUAR_LEFT		5
#define JAGUAR_RIGHT	4

//ENCODERS
#define ENCODER_LEFT_A	3
#define ENCODER_LEFT_B	4
#define ENCODER_RIGHT_A	1
#define ENCODER_RIGHT_B	2

//DISC MAGNET
#define DISC_MAGNET_SOLENOID 8
#define DISC_MAGNET_VICTOR 8

//DISC HANDLING
#define CONVEYOR_VICTOR 7
#define CONVEYOR_PIN_SOLENOID	7
#define TOP_PROX_SENSOR 13
#define MIDDLE_PROX_SENSOR 12
#define BOTTOM_PROX_SENSOR 14

//BREACH
#define BREACH_SOLENOID 		3
#define BREACH_SOLENOID_DOWN 	2
#define BREACH_PROX_SENSOR 		11

//SHOOTER
#define SHOOTER_VICTOR 		1 // 1
#define SHOOTER_SOLENOID	6
//#define SHOOTER_SOLENOID_BACK 5

//SHOOTERANGLE
#define SHOOTER_ANGLE_POT	1
#define SHOOTER_ANGLE_VICTOR	3

//COMPRESSOR
#define COMPRESSOR_SPIKE			3
#define COMPRESSOR_PRESSURE_SWITCH	10

//CLIMBER
#define POPPER_SOLENOID		5
#define POPPER_SOLENOID_DOWN 4
#define PULLER_SOLENOID		1	
#endif
